#include "stm32f4xx.h"
#include "collisionSwitch.h"
/**
 * @brief 碰撞开关状态函数
 * @return true 有碰撞, false 无碰撞
 */
bool collision_seekFront(void)
{
    if (HAL_GPIO_ReadPin(COLLISION_FRONT_GPIO_PORT,COLLISION_FRONT_GPIO_PIN) == RESET)
    {
        HAL_Delay(5);
        if (HAL_GPIO_ReadPin(COLLISION_FRONT_GPIO_PORT, COLLISION_FRONT_GPIO_PIN) == RESET) {
          return true;
        }
    }    
    return false;
}

bool collision_seekBack(void)
{
    if (HAL_GPIO_ReadPin(COLLISION_BACK_GPIO_PORT,COLLISION_BACK_GPIO_PIN) == RESET)
    {
        HAL_Delay(5);
        if (HAL_GPIO_ReadPin(COLLISION_BACK_GPIO_PORT,COLLISION_BACK_GPIO_PIN) == RESET)
        {
            return true;
        }
    }    
    return false;
}
